% 输出处理后的点云。现在输出的是mat。后续根据需要的格式直接改就行了。

p = sortrows(points,5,'descend');
ind = find(p,1,'last');
final_p = p(1:ind);
save([outfile,'.mat'],'final_p');
saveas(fig,[outfile,'.fig']);